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STN ATLAS Elektronik GmbH 

Bremen 



VERFAHREN ZUM BESTIMMEN UND VERFOLGEN VON POSITION UND 
ORIENTIERUNG EINES MAGNETFELDSENSORS 



Die Erfindung betrifft ein Verfahren zum Bestimmen und 
Verfolgen einer von einem Magnetf eldsensor innerhalb eines 
dreidimensionalen Magnetf eldraums eingenommenen, sich 
verSndernden^ wahren Position und Orientierung aus dem vom 
Magnetf eldsensor als Messposition und Messorientierung 
gemessenen Messwerten der im Oberbegriff des Anspruchs 1 
definierten Gattung. 

Zur realitatsgetreuen Simulation von Bildern, die sich mit 
der Anderung von Kopf position und Kopf ausrichtung bzw. 
Kopf orientierung des Betrachters andern, z.B, von in einer 
Nachsichtbrille eines Piloten dargestellten Bildausschnitten 
des Umweltpanoramas, muss der Augenpunkt des Betrachters, und 
damit dessen genaue Kopfposition und -ausrichtung, bekannt 
sein, um den mit der Kopfverlagerung sich andernden 
Bildausschnitt richtig berechnen zu kOnnen. Hierzu wird in 
einem realen Raum, in dem der Betrachter sitzt, z.B. im 
Cockpit eines Flugzeugs oder eines Hubschraubers, ein 
Magnetfeld erzeugt und am Kopf des Betrachters ein 
Magnetf eldsensor zur Sensierung des Magnetf elds befestigt. 
Die von dem Magnetfeldsensor gemessenen Messwerte sind ein 
MaB fur die momentane Kopfposition im Magnetf eldraum, der 
momentanen Orientierung oder Ausrichtung des Kopfes und 
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werden im folgenden Messposition und Messorientierung 
genannt . 

Ein solcher Magnetf eldsensor arbeitet im ungestOrten, 
homogenen Magnetf eld einwandfrei* In den meisten 
Magnetf eldraumen ist jedoch das Magnetf eld infolge des 
Vorhandenseins von unverzichtbaren Metallteilen verzerrt^ so 
z.B. durch die in einem originalgetreu nachgebildeten Cockpit 
eines Flugsimulators vorhandenen Metallstreben. Die von dem 
Magnetf eldsensor ausgegebenen Messwerte weichen dadurch mehr 
Oder weniger erheblich von der wahren Position und 
Orientierung des Magnetf eldsensors im realen Magnetfeldraum 
ab. Im gestOrten Magnetfeldraum ist es daher erforderlich, 
die vom Magnetfeldsensor ausgegebenen Messwerte zu 
korrigieren, um die tatsachliche^ die sog. wahre Position und 
wahre Orientierung des Magnetfeldsensors zu erhalten, die 
unverzichtbar fur eine realit^tsgetreue Simulation der 
Bildausschnitte sind. 

Zur Korrektur der von dem im gestCrten Magnetfeld sich 
befindlichen Magnetfeldsensor ausgegebenen^ fehlerhaften 
Messwerte ist eine Reihe von verschiedenen Verfahren bekannt, 
die jedoch nicht zu einem zumindest fur eine Sichtsimulation 
ausreichenden und bef riedigenden Ergebnis fuhren. Bei einem 
bekannten Verfahren wird der Zusaramenhang zwischen der wahren 
Position und Orientierung des Magnetfeldsensors und den von 
diesem gemessenen Messwerten experimentell ermittelt und in 
einer Kalibriertabelle oder -tafel abgespeichert . In einer 
Vorverarbeitung wird der Kalibrierraum Equidistant 
abgetastetr und mit Hilfe der Kalibriertabelle werden durch 
Interpolation der Positionswerte im realen Magnetfeldraum die 
zugehorigen, realen Positionswerte nahrungsweise gewonnen. In 
der Messphase wird dann eine trilineare Interpolation 



S.AE.202.08DE 



18.02.2003 3 

zwischen den aktuell gemessenen Messpositionen und den realen 
Positionswerten durchgefahrt , um die wahre Position des 
Magnet feldsensors zu erhalten. (Volodymyr Kindratenko 
"Calibration of electromagnetic tracking device". Virtual 
Reality, Research, Development, and Applications, Vol. 4, 
1999, Seiten 139 - 150 unter Verweis auf Raab, Blood, 
Steioner, Jones:" Magnetic position and orientation tracking 
system; IEEE Transactions on Aerospace and Electronic Systems 
1979, 15(5), Seite 709 - 718) • Dieses Verfahren beruht auf 
der Annahme, dass die StOrungen des Magnetfelds in einem 
Raumbereich linear sind, was jedoch nur in Ausnahmef alien 
zutrif f t . 

Der Erfindung liegt die Aufgabe zugrunde, ein robustes 
Verfahren zur Bestimmung der wahren Werte von Position und 
Orientierung eines Magnetf eldsensors aus dem vom 
Magnetf eldsensor ausgegebenen Messwerten anzugeben, dass auch 
in stark verzerrten oder gestorten Magnetf eldern fur die 
Sichtsimulation brauchbare Ergebnisse liefert. 

Die Aufgabe ist erf indungsgem^JJ durch die Merkmale im 
Anspruch 1 gelCst. 

Das erf indungsgemaiie Verfahren hat den Vorteil^. dass die 
unmittelbare Umgebung des Magnetf eldsensors im realen 
Magnet feldraum zur Korrektur der Messwerte herangezogen wird 
und dadurch das Verfahren auch bei 5rtlich unterschiedlich 
stark gestortem Magnetf eld noch gute Ergebnisse liefert, und 
zwar auch unter solchen Bedingungen, bei denen die anderen 
Verfahren bereits versagen. Das erf indungsgemaiie Verfahren 
liefert die wahre Position recht genau und verfolgt diese 
standig, so dass auch bislang auftretende 
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Zweideutigkeitsprobleme bei dem erf indungsgemaiien Verfahren 
vermieden warden. 

ZweckmaiJige Ausftihrungsformen des erf indungsgemaiien 
Verfahrens mit vorteilhaf ten Weiterbildungen und 
Ausgestaltungen der Erfindung ergeben sich aus den weiteren 
Anspriichen. 

Gemali einer vorteilhaf ten Ausf uhrungsf orm der Erfindung wird 
mittels der vier^ der Kalibriertabelle entnommenen 
Kalibrierpositionen, die in dem dreidimensionalen 
Kalibrierraum-Koordinatensystem ein die Messfeldposition 
einschlieJiendes Tetraeder aufspannen, eine 
Transformationsmatrix A so bestimmt/ dass die vier 
Kalibrierpositionen korrekt in das dreidimensionale 
Koordinatensystem des realen Magnet feldraums, nachfolgend 
Realraum-Koordinatensystem genannt, transformiert werden. Zur 
Bestimmung der wahren Position wird dann die 
Transformationsmatrix A auf die Messposition angewendet. 

1st der Positionsvektor der Messposition und p der 
Positionsvektor der transf ormierten Messposition^ die der 
wahren Position des Magnetf eldsensors entspricht, so gilt 

p = A . p^ + p"^^ (1). 

wobei ff^^ ein bei der Transformation zu berlicksichtigender 
Offset ist, 

Um die Bestimmung des Offsets zu vermeiden, wird gemSB einer 
vorteilhaften Ausf uhrungsf orm der Erfindung vor der 
Transformation ein erster der vier Kalibrierpositionen in den 
Ursprung des Kalibrierra\am-Koordinatensystems verschoben und 
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die anderen drei Kalibrierpositionen um die 

Positionskoordinaten der ersten Kalibrierposition verschoben. 
AuBerdem wird von den den vier Kalibrierposition zugehOrigen 
Gitterpunktpositionen die der ersten Kalibrierposition 
zugehorige erste Gitterpunktpbsition in den Ursprung des 
Realraum-Koordinatensystems verschoben und die verbleibenden 
drei Gitterpunktpositionen um die Positionskoordinaten der 
ersten Gitterpunktposition verschoben. Die Transformation in 
den realen Magnetf eldraum, genauer gesagt in das 
dreidimensionale Koordinatensystem des realen Magnetf eldraums 
(Realraum-Koordinatensystem) , wird mit den verschobenen 
Kalibrierpositionen gemSli 

p/ = Ap/'^ miti = 1,2,3 (2) 

durchgefuhrt . Es ergibt sich ein Gleichungssystem aus neun 
Transformationsgleichungen mit neun Unbekannten, aus dem sich 
die Transformationsmatrix A leicht berechnen lasst. Mit jedem 
neuen Messwert werden die das Tetraeder auf spannenden 
Kalibrierpositionen neu bestimmt und wird auch die 
Transformationsmatrix neu berechnet. 

Bei der Anwendung der Transformationsmatrix auf die 
Messposition muss auch letztere zuvor im Kalibrierraum- 
Koordinatensystem entsprechend verschoben werden. Diese 
Verschiebung wird nach Transformation in das Realraum- 
Koordinatensystem wieder riickgangig gemacht und damit die 
wahre Position des Magnetfeldsensors im Magnetf eldraum recht 
genau erhalten. 

Vorteilhafte Ausgestaltungen des erf indungsgem^Ben Verfahrens 
zum schnellen Bestimmen der Kalibrierpositionen, die das die 
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Messposition einschlieJiende Tetraeder aufspannen, sind in den 
weiteren Ansprlichen 5-15 angegeben. 

1st die wahre Position des Magnetf eldsensors auf Basis eines 
Messwerts des Magnetf eldsensors wie beschrieben bestimmt, so 
wird gemSB einer vorteilhaf ten Ausgestaltung der Erfindung 
mit der wahren Position des Magnetsensors eine 
Korrekturorientierung fur den Magnetf eldsensor bestimmt und 
diese zur Ermittlung der wahren Orientierung des 
Magnetf eldsensors auf die Messorientierung angewandt. 

GemaB einer vorteilhaf ten Ausfiihrungsform der Erfindung wird 
zur Bestiiranung der Korrekturorientierung mit den 
Kalibrierorientierungen, deren zugeordnete 

Gitterpunktpositionen im Realraum-Koordinatensystem einen die 
wahre Position des Magnetf eldsensors einschlieiienden Kubus 
aufspannen, eine trilineare Interpolation durchgefiihrt . 

Die Erfindung ist anhand eines in der Zeichnung illustrierten 
Ausfuhrungsbeispiels des Verfahrens im folgenden naher 
beschrieben. Es zeigen: 

Fig. 1 ein Flussdiagramm zur Darstellung des 



Verfahrens, 



Fig. 



2 



ausschnittweise die Strukturierung eines 
Magnet feldraums mit dem dreidimensionalen 
Koordinatensystem y, z in ein 
dreidimensionales Gitter mit aquidistanten 
Gitterpunkten, 



Fig. 



3 



einen Ausschnitt einer im Magnet feldraum 
empirisch aufgenommene Kalibriertabelle, 



S.AE.202.08DE 



18.02.2003 7 

Fig. 4 ausschnittweise eine zweidimensionale 

Darstellung der Kalibrierpositionen in dem 
dreidimensionalen Kalibrierraum- 
Koordinatensystem der Kalibriertabelle zur 
Erlauterung der Kumulierungsposition, 

Fig. 5 ein Beispiel eines von acht 

Gitterpunktpositionen im dreidimensionalen 
Koordinatensystem des realen Magnet feldraums 
auf gespannten KubuS/ 

Fig. 6 ein von den zu den acht Gitterpunktpositionen 
gemafi Fig. 5 zugehOrigen acht 
Kalibrierpositionen im dreidimensionalen 
Kalibrierravim- Koordinatensystem aufgespanntes 
Raumelement , 

Fig. 7 das Raumelement gemSB Fig. 6 mit sechs darin 
enthaltenen Tetraedern, 

Fig. 8 eine Skizze zur Vektordef inition fur die Suche 
eines die Messposition umschlieJienden 
Tetraeders. 

Das im Flussdiagramm der Fig. 1 illustrierte Verfahren dient 
dazu, die Position und Orientierung eines in einem 
dreidimensionalen Magnet feldraiom sich bewegenden 
Magnetf eldsensors auch dann richtig zu bestimmen, wenn das im 
Magnetf eldraum erzeugte Magnetf eld bereichsweise . gestOrt oder 
verzerrt ist und in diesen Bereichen der Magnetfeldsensor 
fehlerhafte Messwerte beziiglich seiner wahren Position und 
Orientierung liefert. Im folgenden werden die vom 
Magnetfeldsensor ausgegebenen Messwerte als Messposition und 
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Messorientierung bezeichnet. Dem Verfahren geht ein 
Kalibriermodus voraus, in dem der Magnet feldraum in ein 
dreidimensionales Gitter mit aquidistanten Gitterpunkten 
strukturiert wird, bei dem vorzugsweise ein Gitterpunkt im 
Ursprung eines dreidimensionalen Koordinatensystems y, z, 
im folgenden Realraum-Koordinatensystem genannt, liegt. Jeder 
Gitterpunkt hat damit einen Positionsvektor p mit den 
Koordinaten y und z. Ein solches Realraum- 
Koordinatensystem mit der Gitterstruktur ist ausschnittweise 
in Fig. 2 dargestellt. Beispielhaft sind dort fur den 
Gitterpunkt 8 die Koordinaten xb, ys und zs angegeben. Der 
Magnetfeldsensor wird nunmehr mit konstanter Ausrichtung oder 
Orientierung nacheinander in alien Gitterpunkten platziert, 
und die in jedem Gitterpunkt von dem Magnetfeldsensor 
gemessenen Messwerte werden als Kalibrierposition und 
Kalibrierorientierung in Zuordnung zu der realen Position des 
Gitterpunktes in einer Kalibriertabelle abgespeichert . In 
Fig. 3 ist ausschnittweise die Kalibriertabelle dargestellt. 
Jeder Gitterpunkt hat einen Positionsvektor p mit den 
Koordinaten x, y, z im realen Magnetf eldraum, dem ein 
Positionsvektor p^ mit den Kalibrierposition x", y^ und 
sowie ein Roatationsvektor der Kalibrierorientierung p^'^ mit 
den Orient ierungswerten fur Gieren (heading) h^, Stampfen 
(pitch) p^ und Rollen (roll) r^ zugeordnet sind. Die 
Kalibrierpositionen liegen in einem dreidimensionalen 
Koordinatensystem des Kalibrierraums, im folgenden 
Kalibrierraum-Koordinatensystem genannt. Im Gegensatz zu den 
Gitterposition im realen Magnet feldraum sind die 
Kalibrierpositionen im Kalibrierraum nicht aquidistant. Die 
Kalibrierung wird nur einmal vorgenommen^ und nur dann erneut 
aufgelegt/ wenn der Magnet feldraum und/oder das darin 
erzeugte Magnet f eld geandert wird. 
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Die in der Kalibriertabelle enthaltenen Daten werden ggf . 
noch bearbeitetr urn beispielsweise falsche Vorzeichen beim 
Hemispharenwechsel zu korrigieren oder durch Interpolation 
Oder Extrapolation fehlende Daten aufzufiillen, die in 
bestimmten Gitterpunkten nicht gemessen werden konnten. 
Bei dem nachstehend im einzelnen beschriebenen Verfahren zur 
Bestimmung der wahren Position und wahren Orientierung des 
Magnetf eldsensors aus den von ihm gelieferten Messwerten wird 
zunachst die wahre Position des Magnetf eldsensors im 
Magnetf eldraum bestimmt und mit dieser dann die wahre 
Orientierung des Magnetf eldsensors emittelt. Kernpunkt der 
Positionsbestimmung ist die Ermittlung von vier 
Kalibrierpositionen aus der Kalibriertabelle, die in dem 
Kalibrierraum-Koordinatensystem ein Tetraeder aufspannen, das 
die vom Magnetf eldsensor aktuell gemessene Messposition 
einschlieJit . Ist ein solches Tetraeder gefunden, so wird mit 
diesen vier Kalibrierpositionen eine linear interpolierende 
Transformation der Messposition in den realen Magnetfeldraum 
vorgenommen und die transf ormierte Messposition als wahre 
Position des Magnetsensors ausgegeben. Hierzu wird mittels 
der vier Kalibrierpositionen eine Transf ormationsmatrix A so 
bestimmt, dass die vier Kalibrierpositionen korrekt in das 
Realraum-Koordinatensystem transf ormiert werden. Mit der so 
gewonnene Transf ormationsmatrix wird die Messposition gemafi 

p = A • p*" + p""^^ (1) 

in das Realraum-Koordinatensystem transf ormiert . p^ ist 
dabei die aktuelle Messposition, p die wahre Position des 
Magnetf eldsensors im Realraum-Koordinatensystem und p""^^ ein 
bei der Transformation zu berticksichtigender Offset* Um die 
Berechnung des Offsets sowohl bei der Berechnung der 
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Transf ormationsmatrix A als auch bei der Anwendung der 
Transf ormationsmatrix A auf die Messposition zur 
Transformation der Messposition in den realen Magnetf eldraum 
zu vermeiden, wird zunachst einer der ersten vier 
Kalibrierpositionen in den Ursprung des dreidimensionalen 
Kalibrierraum-Koordinatensystems verschoben und die andere 
Kalibrierpositionen um die Positionskoordinaten der ersten 
Kalibrierposition verschoben, sowie von den den vier 
Kalibrierpositionen zugeordneten Gitterpunktpositionen die 
der ersten Kalibrierposition zugehSrige erste 
Gitterpunktposition in den Ursprung des dreidimensionalen 
Realraum-Koordinatensystems verschoben und die verbleibenden 
drei Gitterpunktpositionen um die Positionskoordinaten der 
ersten Gitterpunktpositionen verschoben. Mit den so 
verschobenen Kalibrierpositionen p^^'^ und 

Gitterpunktpositionen wird die Kalibrierposition in das 

Realraum-Koordinatensystem gemaii 

P/ = Ap/'^ miti = 1,2,3 (2) 

transf ormiert • Es ergibt sich ein Gleichungssystem mit neun 
Gleichungen und neun Unbekannten, das in Matrizenschreibweise 
wie folgt aussieht: 







-^14 ^1,2 -^1,3 






y/ 




^2,1 -^2,2 -^2,3 






^/ 




^-^3 1 A3^2 -^3,3. 







Aus diesem Gleichungssystem lassen sich die Elemente Ai,i, 
Ai,2.-. der Transf ormationsmatrix A leicht berechnen. Diese 
Transformationsmatrix wird nunmehr nicht direkt auf die 
Messposition angewendet, sondern auf eine Messposition, die 
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in gleicher Weise verschoben worden ist^ wie die drei 
Kalibrierpositionen im Kalibrier-Koordinatensystem. Anders 
ausgedriickt : es wird von dem Positionsvektor der Messposition 
der Vektor derjenigen Kalibrierposition subtrahiert, die in 
den Ursprung des dreidimensionalen Kalibrier- 
Koordinatensystem verschoben worden ist. Die Anwendung der 
Transformationsmatrix auf die verschobene Messposition p^'^ 
erfolgt gemaii 

= Ap^'^ (4). 

Urn aus dieser in den realen Magnetf eldraum transf oimierten, 
noch verschobenen Messposition p^ die wahre Position p des 
Magnetf eldsensors zu erhalten, wird die vorgenommene 
Verschiebung wieder riickgangig gemacht/ und zwar dadurch, 
dass der Positionsvektor der in den Ursprung des Realraum- 
Koordinatensystems verschobenen Gitterpunktposition zu dem 
Positionsvektor der transf ormierten^ verschobenen 

Messposition p^ hinzuaddiert wird. 

Ist die wahre Position des Magnetf eldsensors wie vorstehend 
beschrieben bestimmt, so erfolgt nunmehr die Ermittlung der 
wahren Orientierung des Magnetf eldsensors . Hierzu wird mit 
der wahren Position des Magnetf eldsensors eine 
Korrekturorientierung bestimmt und zur Ermittlung der wahren 
Orientierung auf die vom Magnet sensor gemessene 
Messorientierung angewendet. Zur Bestimmung der 
Korrekturorientierung werden in der Kalibriertabelle acht 
Kalibrierpositionen ausgesuchtr deren zugeordnete 
Gitterpunktpositionen in dem Realraum-Koordinatensystem einen 
Kubus aufspannen, der die wahre Position des 
Magnetf eldsensors umschlieBt. Mit diesen acht 



S.AE.202,08DE 



18.02.2003 12 

Kalibrierorientierungen wird eine trilineare Interpolation 
durchgefuhrt, deren Ergebnis die Korrekturorientierung 
ergibt. Diese Korrekturorientierung wird entweder auf die 
Orientierungswerte h^, und r^ einzeln angewendet Oder 
vorzugsweise auf den von diesen Werten gebildeten 
Rotationsvektor p^'^ angewendet. 

Zum Priafen eines von vier Kalibrierpositionen im 
Kalibrierraum-Koordinatensystem der Kalibriertabelle 
auf gespannten Tetraeders daraufhin^ ob es die Messposition 
einschlieBt oder nicht^ im folgenden Tetraederpriif ung 
genannt, wird fur alle vier Tetraederf ISchen eines Tetraeders 
f estgestellt ^ auf welcher Seite der Tetraederf lache die 
Messposition liegt. Liegt die Messposition bei alien vier 
Tetraederf lachen auf derselben Seite der Tetraederf lache wie 
der jeweils nicht zur Tetraederf lache zugehorige vierte 
Tetraederpunkt , so wird das Tetraeder als das gesuchte 
erkanntr das die Messposition einschlielit . 

Durch die Verwendung von Tetraederf lachen bei der Suche nach 
der eingeschlossenen Messposition werden Unstetigkeiten bei 
der interpolierten Magnetf eldsensorposition vermieden. In 
Fig. 8 ist ein solches von den Kalibrierpositionen 
aufgespanntes Tetraeder dargestellt. Der Einfachheit halber 
sind die Eckpunkte des Tetraeders, die jeweils einem 
Positionsvektor einer Kalibrierposition im Kalibrierraum- 
Koordinatensystem entsprechen, mit Pi, P2, P3 und P4 
bezeichnet. Der Positionsvektor der Messposition in dem 
Kalibrierraum-Koordinatensystem ist mit Pm bezeichnet. Um nun 
zu erkennen, auf welcher Seite der von den Eckpunkten Pi, P2, 
P3 bzw. Pi, P2, P4 bzw. Pi, P3, P4 bzw. P2, P3/ P4 auf gespannten 
Tetraederf ISchen die Messposition liegt, werden, wie dies in 
der Vektordarstellung der Fig. 8 illustriert ist, zwischen 
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dem ersten Eckpunkt Pi der Tetraederf lache Pi, P2, P3 und den 
beiden Eckpunkten P2 bzw. P3 dieser Tetraederf lache zwei 

Vektoren PjPj bzw. P^P^ definiert und deren Kreuzprodukt PjPj x 

P1P3 berechnet. Dieses Kreuzprodukt ergibt einen 
Produktvektor, der senkrecht auf den beiden Vektoren steht^ 
also die Normale zu der betrachteten Tetraederf lache Pi, P2/ 
P3 ist. Zwischen dem ersten Eckpunkt der Tetraederf lache Pi 
und den nicht in die Tetraederf ISche einbezogenen vierten 
Tetraederpunkt P4 einerseits und dem ersten Eckpunkt Pi und 
der Messposition Pm andererseits wird jeweils ein weiterer 

Vektor P1P4 und P^P^ definiert, und es werden die 
Skalarprodukte des Kreuzproduktvektors mit jedem der weiteren 
Vektoren P1P4 bzw. PjP^^ berechnet. Haben die Skalarprodukte 
das gleiche Vorzeichen, so wird die Messposition Pm als auf 
der richtigen Seite der betrachteten Tetraederf lache liegend 
erkannt. Die Berechnung des Kreuzproduktes und der 
Skalarprodukte wird fur jede der vier Tetraederf lachen 
durchgef iihrt . Wenn die Messposition bei alien 
Tetraederf lachen als auf der richtigen Seite liegend erkannt 
worden sind, ist das von den vier Tetraederf ISchen gebildete 
Tetraeder das gesuchte Tetraeder, das die Messposition 
einschlielit . 

Die Suche nach den geeigneten vier Kalibrierpositionen, die 
die Messposition einschlieBen und damit zur linearen 
interpolierenden Transformation der Messposition benutzt 
werden miissen, wird - wie dies im Flussdiagramm der Fig. 1 
illustriert ist - in folgender Weise durchgef lihrt : 

Mit dem Anliefern der ersten Messposition durch den 
Magnetfeldsensor setzt eine globale Suche in der 
Kalibriertabelle, im folgenden Globalsuche genannt, ein. 
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Hierbei wird ftir alle abgespeicherten Kalibrierpositionen der 
Tabelle der Abstand von der Messposition bestimmt und 
diejenige Kalibrierposition mit dem kleinsten Abstand, im 
folgenden Global-Kalibrierposition genannt, ausgegeben. Urn 
die Rechenzeit fur diesen Prozess abzukiirzen, wird in einer 
der Globalsuche vorgeschalteten Initialisierung eine 
Vorauswahl von Kalibrierpositionen getroffen, die auf den 
kleinsten Abstand zur Messposition untersucht werden. Hierzu 
wird die Tabelle in mehrere Tabellenbereiche unterteilt und 
in jedem Tabellenbereich eine Kumulationsposition definiert. 
Die Kumulationspositionen werden dabei so festgelegt^ dass zu 
ihrer Ermittlung ungefsihr die gleiche Anzahl von 
Kalibrierpositionen verwendet worden sind. In Fig. 4 ist zur 
Illustration des Initialisierungsvorgangs ein 
zweidimensionaler Ausschnitt der in der Tabelle 
abgespeicherten Kalibrierpositionen durch schwarze Punkte 
dargestellt. In diesem Ausschnitt sind zwei Tabellenbereiche 
definiert, die durch die Grenzlinie G voneinander getrennt 
sind. In jedem Bereich ist eine Kumulationsposition (durch 
Kreuz markiert) festgelegt. Die Globalsuche wird nun so 
vorgenommen, dass mit Eintreffen des ersten Messwerts des 
Magnetf eldsensors nicht der Abstand der Messposition von 
alien Kalibrierpositionen, sondern lediglich der Abstand der 
Messposition von den Kumulationspositionen bestimmt wird. Die 
Kumulationsposition mit dem kleinsten Abstand von der 
Messposition wird als Global-Kalibrierposition ausgegeben. 

Mit dem nfichsten Messwert wird ausgehend von der Global- 
Kalibrierposition eine sog. Umgebungssuche durchgefiihrt . Bei 
der Umgebungssuche wird eine Vielzahl von 

Kalibrierpositionen, deren zugehOrige Gitterpunktpositionen 
im realen Magnetf eldraum eine Mehrzahl von 
aneinanderstolienden Kuben um eine zentrale 



S.AE.202. 08DE 



18.02.2003 15 

Gitterpunktposition herum aufspannen, definiert. In Fig. 2 
sind beispielsweise acht aneinanderstoliende Kuben 
dargestellt, die um die zentrale Gitterpunktposition 
(Gitterpunkt 8) herum aufgespannt sind. Als zentrale 
Gitterpunktposition (Gitterpunkt 8) wird die 
Gitterpunktposition, die der in der Globalsuche ermittelten 
Global-Kalibrierposition zugehOrig ist, festgelegt. Wie aus 
dem Vergleich von Fig. 5 und 6 zu erkennen ist, sind den acht 
Gitterpunktpositionen eines jeden Kubus acht 
Kalibrierpositionen in der Kalibriertabelle zugeordnet, die 
zusammen ein achteckiges, unsymmetrisches Raumelement in dem 
Kalibrierraum-Koordinatensystem aufspannen. Wie Fig. 7 zeigt, 
lasst sich dieses Raumelement in sechs Tetraeder unterteilen. 
Im Ausftihrungsbeispiel mit acht definierten Kuben ergeben 
sich acht Raumelemente mit jeweils sechs Tetraeder. Bei der 
Umgebungssuche wird nunmehr fur jedes der Tetraeder eine 
Tetraederprtifung durchgefiihrt , wie sie vorstehend beschrieben 
worden ist. Wird bei der Umgebungssuche kein Tetraeder 
gefunden, das das Priif kriterium erfiillt, so wird mit dem 
nachsten Messwert die Globalsuche erneut gestartet und danach 
eine neuerliche Umgebungssuche durchgef Qhrt . Ist bei der 
Umgebungssuche ein die Messposition umschliefiender Tetraeder 
gefunden worden, so wird die Prtifung weiterer Tetraeder 
gestoppt und mit den das gefundenen Tetraeder def inierenden 
Kalibrierpositionen die linear interpolierende 
Transformation, wie sie eingangs beschrieben worden ist, 
durchgef tihrt . Nach der so bestimmten wahren Position des 
Magnetfeldsensors wird dessen wahre Orientierung ermittelt 
und der nachste Messwert vom Magnetf eldsensor abgewartet . 

Trifft ein neuer Messwert ein, so wird in der 
Kalibriertabelle zum Aufsuchen der geeigneten vier 
Kalibrierpositionen, die in dem Kalibrierraum- 
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Koordinatensystem das die Messposition einschlieJiende 
Tetraeder aufspannen, eine Lokalsuche gestartet. Hierzu 
warden acht Kalibrierpositionen verwendet, deren zugehorige 
Gitterpositionen im Realraum-Korrdinatensystem einen Kubus 
beschreiben, wie er in Fig. 5 dargestellt ist. Die diesem 
Kubus zugehSrigen acht Kalibrierpositionen definieren in dem 
Kalibrierraum-Koordinatensystem ein achteckiges Raumelement / 
wie es in Fig. 6 dargestellt ist. Dieses Raumelement enthait 
wiederum sechs Tetraeder, wie sie in Fig. 7 mit den Ziffern 1 
bis 6 gekennzeichnet sind. Bei der Lokalsuche wird fiir jedes 
der sechs Tetraeder eine TetraederprUf ung wie beschrieben 
durchgefiihrt . Bei der Lokalsuche wird ein solcher Kubus bzw. 
ein dazugeh5riges Raumelement ausgewShlt, in dem in dem 
vorausgegangenen Messzyklus ein die Messposition 
umschlieliendes Tetraeder gefunden worden ist. Allgemein wird 
die Auswahl des Kubus durch Pradiktion anhand 
vorausgegangener Messzyklen bestimmtr wobei sich die im 
vorausgegangenen Messzyklus gefundene wahre Position als 
einfachste Pradiktion anbietet. Wird bei der Lokalsuche ein 
die Messposition umschlieJiendes Tetraeder gefunden, so wird 
mit den das Tetraeder festlegenden vier Kalibrierpositionen 
die linear interpolierende Transformation der Messposition 
durchgeftihrt und mit der dadurch erhaltenen wahren Position 
des Magnetfeldsensors die wahre Orientierung des 
Messf eldsensors bestimmt. Danach wird auf den nSchsten vom 
Magnetfeldsensor gelieferten Messwert gewartet. Da in aller 
Regel ein Tetraeder gefunden wird, das die Messposition des 
neuen aktuellen Messwerts einschlieiit, wird das Verfahren zum 
groJien Teil innerhalb des in Fig. 1 strichpunktiert 
eingerahmten Verfahrensabschnitts ablaufen. 

Wird bei der Lokalsuche nach Prufung aller sechs Tetraeder 
kein passendes Tetraeder gefunden, so wird eine 
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Umgebungssuche durchgefuhrt , wie sie vorstehend beschrieben 
worden ist. Als zentrale Gitterpunktposition, um die herum 
die aneinanderstoJienden Kuben aufgespannt werden, wird eine 
pradiktierte Gitterpunktposition gewahlt, wobei die 
Pradiktion anhand vorausgegangener Messzyklen erfolgt. Im 
einfachsten Fall wird diejenige Gitterpunktposition als 
zentrale Gitterpunktposition pradiktierte die der im 
vorausgegangenen Messzyklus bestimmten wahren Position am 
nSchsten liegt. Wird hierbei das passende Tetraeder gefunden, 
so setzt wiederum die Positionsbestimmung und 

Orientierungsbestimmung ein, und es wird der nachste Messwert 
abgewartet. Wird auch in der Umgebungssuche kein passendes 
Tetraeder gefunden, so werden die in dem vorhergehenden 
Messzyklus ermittelten Werte fiir die wahre Position und die 
wahre Orientierung des Magnetsensors "eingef roren", d. h. 
beibehalten und aufgrund des aktuellen Messwerts nicht 
verandertr und der nSchste Messwert abgewartet. 
Da mit dem Einfrieren die Positionsverf olgung unterbrochen 
worden ist, wird mit dem nachsten neuen Messwert des 
Magnetf eldsensors die Globalsuche wie vorstehend beschrieben 
durchgefuhrt und dabei die Global-Kalibrierposition 
ermittelt. Mit dem Messwert und der bestimmten Global- 
Kalibrierposition wird eine Umgebungssuche durchgefuhrt, und 
zwar in der gleichen Weise wie beschrieben. Wird bei der 
Umgebungssuche das passende Tetraeder gefunden, so wird mit 
dessen Kalibrierposition wiederum die wahre Position und 
danach die wahre Orientierung des Magnetf eldsensors bestimmt. 
Ist aiich bei dieser Umgebungssuche kein passendes Tetraeder 
gefunden worden, so werden die im vorhergehenden. Messzyklus 
bestimmten Werte fUr wahre Position und wahre Orientierung 
des Magnetf elssensors "eingef roren" und der nSchste Messwert 
abgewartet. Mit dem nachsten neuen Messwert wird eine 
neuerliche Umgebungssuche durchgefuhrt und bei Auffinden 
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eines passenden Tetraeders eine Positions- und 
Orientierungsbestimmung ausgelCst und bei Nichtauf f inden 
eines passenden Tetraeders ein erneutes Einfrieren der im 
vorausgegangenen Messzyklus bestimmten wahren Werte von 
Position und Orientierung vorgenommen, woraufhin mit dem 
nachsten neuen Messwert eine Globalsuche gestartet wird. 
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PATENTANS PRUCHE 

1. Verfahren zum Bestimmen und Verfolgen einer von einem 
Magnetf eldsensor innerhalb eines dreidimensionalen 
Magnet feldraiams eingenommenen, sich verSndernden, wahren 
Position und Orientierung aus von dem Magnetfeldsensor 
als Messposition und Messorientierung gemessenen 
Messwerten, bei dem in einem Kalibriermodus der 
Magnetfeldraum in ein dreidimensionales Gitter mit 
aquidistanten Gitterpunkten strukturiert wird und die von 
dem mit konstanter Orientierung nacheinander in alien 
Gitterpunkten platzierten Magnetfeldsensor gemessenen 
Messwerte als Kalibrierpositionen und 
Kalibrierorientierungen in Zuordnung zu den realen 
Positionen der Gitterpunkte im dreidimensionalen 
Koordinatensystem des realen Magnetf eldraums (Realraum- 
Koordinatensystem) in einer Kalibriertabelle 
abgespeichert werden, dadurch gekennzeichnet, dass fiir 
die fortlaufend gemessenen, aktuellen Messwerte des 
Magnetf eldsensors jeweils mit vier aus der 
Kalibriertabelle entnommene Kalibrierpositionen, die in 
einem dreidimensionalen Koordinatensystem der 
abgespeicherten Kalibrierpositionen (Kalibrierraum- 
Koordinatensystem) ein die Messposition. einschlieliendes 
Tetraeder aufspannen, eine linear interpolierende 
Transformation der Messposition in das Realraum- 
Koordinatensystem vorgenommen und die transf ormierte 
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Messposition als wahre Position des Magnetsensors 
ausgegeben wird, 

2, Verfahren nach Anspruch 1^ dadurch gekennzeichnet, dass 
mittels der vier Kalibrierpositionen eine 

Transf orroationsmatrix (A) so bestirrant wird, dass die vier 
Kalibrierpositionen korrekt in das Realraum- 
Koordinatensystem transf ormiert werden, und dass die 
Messposition mittels der Trans format ionsmatrix (A) 
transf ormiert wird. 

3. Verfahren nach Anspruch 2, dadurch gekennzeichnet , dass 
vor der Transformation ein erster der vier 
Kalibrierpositionen in den Ursprung des Kalibrierraum- 
Koordinatensystems verschoben wird und die anderen drei 
Kalibrierpositionen um die Positionskoordinaten der 
ersten Kalibrierposition verschoben werden, sowie von den 
den vier Kalibrierpositionen zugeordneten vier 
Gitterpunktpositionen die der ersten Kalibrierposition 
zugehorige erste Gitterpunktposition in den Ursprung des 
Realraum-Koordinatensystems verschoben wird und die 
anderen drei Gitterpunktpositionen um die 
Positionskoordinaten der ersten Gitterpunktposition 
verschoben werden und dass die Transformation mit den 
verschobenen Kalibrierpositionen { p^^'^ ) und den 
verschobenen Gitterpunktpositionen ( p/^ ) gemaii 

p/ = Ap/''' mit i = 1, 2, 3 (1) 

durchgeftihrt wird. 
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4. Verfahren nach Anspruch 3, dadurch gekennzeichnet , dass 
die Transformationsmatrix (A) auf die urn die 
Positionskoordinaten der ersten Kalibrierposition 

verschobene Messposition ( p^'^ ) gemaii 

p"" = Ap''''' (2) 
angewendet und nach der Transformation die Verschiebung 
im Realraum-Koordinatensystem wieder riickgangig gemacht 
wird. 



5. Verfahren nach einem der Anspriiche 1-4, dadurch 
gekennzeichnet , dass zum Priifen eines Tetraeders auf 
Einschluss der Messposition festgestellt wird, auf 
welcher Seite der Tetraederf lachen die Messposition 
liegtr und dass die Messposition als im Tetraeder 
eingeschlossen erkannt wird, wenn die Messposition bei 
alien vier Tetraederf ISchen auf derselben Seite der 
Tetraederf lache liegt wie der jeweils nicht in die 
Tetraederf lache einbezogene vierte Tetraederpunkt . 

6. Verfahren nach Anspruch 5, dadurch gekennzeichnet, dass 
zwischen einem ersten Eckpunkt (Pi) der Tetraederf Ifiche 
und den beiden anderen Eckpunkten {P2, P3) zwei Vektoren 
definiert und deren Kreuzprodukt berechnet wird, dass 
zwischen dem ersten Eckpunkt (Pi) der Tetraederf lache und 
dem nicht in die Tetraederf lache einbezogenen vierten 
Tetraederpunkt (P4) einerseits und der Messposition (Pm) 
andererseits jeweils ein weiterer Vektor definiert wird, 
dass die Skalarprodukte des sich aus dem Kreuzprodukt 
ergebenden, die Normale zur Tetraederf ISche bildenden 
Kreuzproduktvektors mit jedem der weiteren Vektoren 
berechnet werden, und dass die Messposition als auf der 
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richtigen Seite der Tetraederf ISche liegend erkannt wird, 
wenn die Skalarprodukte das gleiche Vorzeichen haben. 

7. Verfahren nach Anspruch 5 Oder 6, dadurch gekennzeichnet/ 
dass das Bestimmen der Kalibrierpositionen, die das die 
Messposition einschlieliende Tetraeder aufspannen, mittels 
Lokalsuche in einem von acht Kalibrierpositionen im 
Kalibrierraum-Koordinatensystem auf gespannten Raumelement 
durchgefilhrt wird, die acht einen Kubus im Realraum- 
Koordinatensystem beschreibenden Gitterpunktpositionen 
zugehOrig sind, indem fiir jedes der in dem Raumelement 
enthaltenen sechs Tetraeder eine TetraederprUfung 
durchgefiihrt wird. 

8. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass 
ein solcher Kubus ausgewahlt wird, in dem eine anhand 
mindestens eines vorausgegangenen Messzyklusses 
pradiktierte wahre Position liegt. 

9. Verfahren nach einem der AnsprUche 5-8, dadurch 
gekennzeichnet, dass zum Bestimmen der Kalibrierposition, 
die das die Messposition einschliefiende Tetraeder 
aufspannen, mittels Umgebungssuche in einem von 
Kalibrierpositionen im Kalibrierraum-Koordinatensystem 
aufgespannten Raumelement durchgefiihrt wird, deren 
zugehOrige Gitterpunktpositionen im Realraum- 
Koordinatensystem eine Mehrzahl von aneinanderstofienden, 
um eine zentrale Gitterpunktposition gruppierten Kuben 
beschreiben, indem fiir jedes der im Raumelement 
enthaltenen Tetraeder eine Tetraederpriifung durchgefiihrt 
wird. 
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10. Verfahren nach einem der Anspriiche 7-9, dadurch 
gekennzeichnet , dass die Tetraederpruf ung abgebrochen 
wird, sobald ein die Messposition einschlieliendes 
Tetraeder gefunden wird. 

11. Verfahren nach Anspruch 9 Oder 10^ dadurch 
gekennzeichnet, dass als zentrale Gitterpunktposition 
diejenige Gitterpunktposition gewShlt wird, die einer 
anhand mindestens eines vorausgegangenen Messzyklusses 
pradiktierten wahren Position am nachsten liegt. 

12. Verfahren nach Anspruch 9 oder 10, dadurch 
gekennzeichnet, dass als zentrale Gitterpunktposition 
diejenige Gitterpunktposition gewahlt wird, deren 
zugehOrige Kalibrierposition einer Global- 
Kalibrierposition am nachsten liegt, die in einer im 
Kalibrierraum-Koordinatensystem durchgef uhrten 
Globalsuche eimiittelt wird. 

13. Ver-fahren nach Anspruch 12, dadurch gekennzeichnet , dass 
bei der Globalsuche fur alle in der Kalibriertabelle 
abgespeicherten Kalibrierpositionen der Abstand von der. 
Messposition bestimmt und die Kalibrierposition mit dem 
kleinsten Abstand als Global-Kalibrierposition ausgegeben 
wird. 

14. Verfahren nach Anspriach 12, dadurch gekennzeichnet, dass 
die Kalibriertabelle in mehrere Tabellenbereiche 
unterteilt wird und ftir jeden Tabellenbereich eine 
Kumulationsposition definiert wird und dass bei der 
Globalsuche der Abstand der Messposition von den 
Kumulationspositionen bestimmt und die 
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Kumulationsposition mit dem kleinsten Abstand als Global- 
Kalibrierposition ausgegeben wird. 

15. Verfahren nach Anspruch 14, dadurch gekennzeichnet , dass 
die Tabellenbereiche so festgelegt werden, dass jede 
Kumulationsposition mit einer ungeffihr gleich grolien 
Anzahl von Kalibrierpositionen bestimmt wird. 

16. Verfahren nach einem der AnsprOche 1 - 15, dadurch 
gekennzeichnet, dass mit der bestimmten wahren Position 
des Magnetf eldsensors eine Korrekturorientierung 
ermittelt und zur Bestimmung der wahren Orientierung des 
Magnetf eldsensors auf die Messorientierung angewandt 
wird. 

17. Verfahren nach Anspruch 16, dadurch gekennzeichnet , dass 
zur Ermittlung der Korrekturorientierung mit den 
Kalibrierorientierungen, deren zugeordnete 

Gitterpunktpositionen im Realraum-Koordinatensystem einen 
die wahre Position einschlieJienden Kubus aufspannen, eine 
trilineare Interpolation durchgefiihrt wird- 
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Zusammenf assung 

VERFAHREN ZUM BESTIMMEN UND VERFOLGEN VON POSITION UND 
ORIENTIERUNG EINES MAGNETFELDSENSORS 



Bei einem Verfahren zum Bestimmen und Verfolgen einer von 
einem Magnetf eldsensor innerhalb eines dreidimensionalen 
Magnetfeldraums eingenommenen, sich verSndernden, wahren 
Position und Orientierung aus den Messwerten des 
Magnetf eldsensors wird in einen vorausgehenden Kalibriermodus 
der Magnetfeldraum in einem dreidimensionalen Gitter mit 
aquidistanten Gitterpunkten strukturiert und werden alle 
Messwerte, die von dem mit konstanter Orientierung 
nacheinander in alien Gitterpunkten platzierten 
Magnetf eldsensor gemessen werden als Kalibrierposition und 
Kalibrierorientierungen in Zuordnung zu den realen Positionen 
der Gitterpunkte im Magnetfeldraum in einer Kalibf iertabelle 
abgespeichert . Zur Erzielung eines robusten Verfahrens, das 
auch in stark verzerrten oder gestOrten Magnetf eldern genaue 
Ergebnisse zur Bildberechnung fur Sichtsimulatoren geeignet 
sindr wird fur die fortlaufend gemessenen, aktuellen 
Messwerte des Magnetf eldsensors jeweils mit vier aus der 
Kalibriertabelle entnommenen Kalibrierpositionen^ die ein die 
Messposition einschliefiendes Tetraeder aufspannen, eine 
linear interpolierende Transformation der Messposition in den 
realen Magnetfeldraum vorgenommen. 
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